#ifndef ROBOT_POSE_H
#define ROBOT_POSE_H

#include <stack>

struct Pose
{
    double x;
    double y;
    double yaw;
};

struct NavigationData
{
    uint8_t mode; //上层下发的导航模式 0正常 1召唤 2带人
    std::stack<Pose> goals;//导航目标点
    std::string map_id; //导航地图id
};

class RobotPose
{
public:
    double getX() const
    {
        return x_;
    }
    void setX(double x)
    {
        RobotPose::x_ = x;
    }
    double getY() const
    {
        return y_;
    }
    void setY(double y)
    {
        RobotPose::y_ = y;
    }
    double getYaw() const
    {
        return yaw_;
    }
    void setYaw(double yaw)
    {
        RobotPose::yaw_ = yaw;
    }

private:
    double x_;
    double y_;
    double yaw_;
};

#endif //ROBOT_POSE_H
